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CSI MODELLING AND 
CONTROL ISSUES 

SMALL, DEXTEROUS MANIPULATORS 

LARGE, CRANE-LIKE MANIPULATORS 

dynamics 

controls 

dynamics 

controls 

Lumped compliance due 
to actuator geartrain 

Dcmnanl Effect 
(free- free resonance modes 
in the 10-30 Hz range, 
£=0.1 for FTS-like aims 
with Harmonic Drive 
gearings) 

Active damping of geartrain 
mode is achieved with either 
analog/digital colocated rale 
feedback or analog output 
torque feedback. 

Effect is as or more 
important than distributed 
flexibility (lowest locked 
joint frequency for RMS in 
the 0.1 to 2 Hz range, 
depending on load) 

RMS control system is 
based on analog/digital 
colocated rate control (PI). 
Active CSI controller using 
links and wnst-mounted 
sensors have been 
demonstrated in the lab. 

Distributed flexibility 
in the links 

No significant effect except 
for lumped compliances 
snsing from mechanical 
interfaces, actuator housing 
and end-effectors. 

Control system should 
iKiude active fibers to gain 
stabilize flexible modes due 
to lumped compliances. 
Other approach is to use 
passive damping if it is 
feasible. 

Significant effect, especially 
for the cases of very large 
payloads (RMS dominant 
elastic mode in the 0.03 to 
0.4 Hz range, depending on 
load. 

RMS control system based 
on colocated rate feedback 
damps out elastic modes but 
at the expense of rigid-body 
bandwidth. Laboratory 
systems are currently testing 
CSI -based controllers using 
links and wrist-mounted 
sensors. Future space arms 
will have control modes 
based on proxomity/vision 
sensing systems. 

Rigid & elastic 
payloads with lightly 
damped vibration 
modes 

Important effect as 
dexterous robots will be 
used for spacecraft servicing 
(dominant payload 
frequencies can be inside or 
otaside the robot control 
system nominal bandwidth) 
(typically, am 1 to 3 Hz) 

No general control approach 
developed yet Conventional 
robot controlkn can be 
tuned to act as vibration 
absorber for elastic payload. 
Robot controller acts at a 
colocated controller for the 
elastic payload. 

For each flown payload 
detailed pie- flight 
simulations are nn for the 
RMS. Special studies need 
to be run to aim dynamic 
coupling when payload 
fundamental vibration mode 
(clamped interface) is below 
0.5 Hz. Future RMS-like 
arm will need to handle 
massive and elastic systems. 

No general control approach 
yet developed. As for rigid 
aims, conventional 
colocated rate controllers 
will not destabilize the 
payload elastic modes. For 
performance, additional 
savors will be needed to 
increase active damping on 
dominant payload modes m 
necessary. A general 
approach will have to 
consider the cooperative use 
of the payload attitude 
control system together with 
the arm controller. 

Compliant base or free- 
flying base 

Important eJTea for 
dexterous arms mounted on 
a space station oode or on a 
stabilizer arm or at the end 
of a long, flexible RMS-like 
manipulator. 

Practical engineering 
solutions will have to be 
developed. Use of wrist 
mounted or body-mounted 
sensors for active feedback 
of base mode will be key to 
effective control. Passive 
energy dissipation 
mechanisms (friction 
brakes, viscoelastic mounts) 
will need to be designed. 

The Space Shuttle/RMS 
system is the first free- flyer 
servicing spacecraft Free- 
flying base effect becomes 
more important as payload 
mass becomes comparable 
to Shuttle mai/inertia. 
Compliance of Space- 
Station RMS mount on truss 
needs to be accounted for 
in design. Cooperative use 
of the base and the arm 
oontroUen will be needed 
for future autonomous 
operations. 

Effect of base compliance 
shows up as pairs of lightly 
damped poles and zeroes in 
each joint open-loop transfer 
fueboo. Effective damping 
of these modes can be 
increased through a 
combination of colocated 
control and wrisfrbese- 
mounted sensors 
(accelerometers and/or 
inertial position sensors) 
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Control of Elastic Payloads: 1-DOF Example 

• 1-DOF rigid arm with 1-DOF elastic payload: 



Arm I Payload 
Force 
Sensor 


• M A = Arm Mass 

• M P = M P1 + M P2 = Payload Mass 

• B P is small {lightly damped elastic mode) 


• Payload dynamics can be defined by its dynamic stiffness: 



Payload 
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• Equations of motion for arm/payload system can be expressed in terms of 
the INDIVIDUAL arm & payload dynamics: 



• Assume standard PD control for robot arm: 

U = ~ k A ( X A" X A)- k R X A 

• Arm is acting as a colocated actuator/ 
sensor pair for payload. 

=> ELASTIC MODE ALWAYS STABLE 

• Payload closed-loop elastic mode is a function of the ratio ^ 
where: 

co A = Rigid Arm Closed- 
Loop Bandwidth 

Qp = First Cantilevered 

Vibration Frequency 
of the payload 
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Control of Elastic Payloads: 1-POF Example (cont'd) 


• For cases where arm controller is "detuned" ( co A » a ), we can 
implement an additional IMPEDANCE control law to actively damp the 
payload's elastic mode: 



impedance 

Control 


•We Have: x P =x P 


(High-Gain PD Control) 


c 

Xp = 


-Fr 


p = B — - K (Impedance Control) 


} 


F P - - ( Bj s + Kj ) Xi 


=> Force f p applied to payload acts as a virtual spring/damper 
selected by the user !! 


• Root-Locus vs. Force 
Sensor Gain: 



=> With proper choice of [ K, , B, ] 
gains, payload elastic mode is 
actively damped ! 
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Control of Elastic Payloads: Planar Arm Example 


Three DOF Arm with 
Elastic Beam Payload: 



• Payload linearized dynamics model is obtained from FEM techniques 
applied to elastic body on moving base: 


M rr Mre 
M re Mee 


Q 3^ 3n 


qr 

+ 

0 3 Q 3n 


qr 



F P 

Q n3 O ee 


Qe 


2 n3^ee 


qe 


0 


q r = 

*c 

yc 

= rigid interface DOFs 

F p = 

>x' 

F y 

= external forces/torque exterted on payload 


C 



T<t> 

by arm. 


• In summary: 


F x ( s ) 


x c (s) 

Fy (S) 

= Zp (S) 

y c ( s > 

To(s) 


<M S > 


where 



(s) = DYNAMIC STIFFNESS of ELASTIC PAYLOAD 


• Arm dynamics linearized around given 
configuration: 


xc 



M(0o) 9 = Ia + J (So) Ec w ^h 


Can be transformed in terms of 
end-effector coordinates xc: 


M(xq) xc = J (So) 1a + Ec with 



0s" 


Ts 


H 

X 

_2_j 

s = 

0E 

0vv 

Ta = 

Te 

Tw 

Ec = 

T Vc 

c 


M(0o) = 3x3 inertia matrix 


J (So) = Jacobian matrix expressed 
in end-effector frame 


M (xo) = "Cartesian" inertia matrix 

= J T (So) M(So) J T (So) 


* Coupled arm / payload dynamics: 
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Control of Elastic Payloads: Planar Arm Example 



Sensor 


[ 3 -DOF Harmonic 
Drive Arm 


Flexible Bean 
Payload 


Atrpad {Typical) 


Single Axis 
Accelerometer 


Glass Top 
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Control of Elastic Payloads: Planar Arm Example 


• System Block Diagram: 



• Characteristic frequencies for 
3-DOF Arm & Payload dynamic 
system (derived using 
TREETOPS multi-body software): 



Fl (Hz) 

F 2 (Hz) 

F3 (Hz) 

Arm Joints 
Locked 

1.2 

14.0 

42.2 

Arm Joints 
Free 

2.1 

14.3 

42.3 


• Arm Mass 
Properties: 


Link 

Mass 

(kg) 

Center of 
Mass (m) 

MOI 

(kg-m 2 ) 

Link Length 
(m) 

Shoulder 

13.8 

0.406 

0.77 

0.56 

Elbow 

10.1 

0.37 

0.607 

0.56 

Wrist 

13.7 

0.14 

0.106 

0.254 


• Payload 
Mass 

Properties: 


Part 

Mass 

(kg) 

Center of 
Mass (m) 

El 

(N-m 2) 

Link Length 
(m) 

Beam 

0.4 

0.38 

7.28 

0.765 

Tip Mass 

0.7 

— 
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Control of Elastic Payloads: Planar Arm Example (cont’d) 


• Arm controller is designed assuming a rigid payload: 

- Independent analog torque loop controllers (elastic gearmotors behave as 
direct drive actuators) 

- Standard nonlinear control law: T a = M rr ( 0 ) [ - K P ( 6 -0 ) - K R 0 ] 

• For a rigid arm, closed-loop dynamics is approximated by 3 
decoupled second-order integrators. 

• For a rigid arm with elastic payload, arm can be treated as a 
virtual cartesian 3-dof colocated actuator/sensor pair. 

• Dominant payload closed-loop elastic mode is a function of the ratio — 

where: a ° 

to a = Rigid Arm Closed- 
Loop Bandwidth 


= First Clamped 
Vibration Frequency 
of the Payload 



Experimental time responses for an initial payload elastic deformation: 



422 





Control of Elastic Payloads: Planar Arm Example ( cont'd) 

• For cases where arm controller is detuned (coa > £2p), we can implement an 
impedance control law to actively damp dominant payload elastic modes: 



• We Have: 


0 s <(> (High-Gain PD Control) 
c -T* 

0 = B (Impedance Control) 


} 




=> Torque T<t> applied to payload acts as a virtual spring/damper 
selected by the user !! 


Experimental time responses for an initial payload elastic deformation: 


Impedance controller: 



0 12 3 4 5 6 7 

time (sec) 


Arm acts as a rigid base: 



0 12 3 4 5 6 7 

time (sec) 
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Control of Elastic Arms: Testbed Description (cont'd) 


• System Block Diagram: 



Control of Elastic Arms: Dynamic Modelling 


• Modelling tool is the multi-flexible body dynamic analysis code TREETOPS: 

- Code developed by Dynacs for NASA-MSFC can simulate controlled 
dynamics of a general chain of articulated rigid and elastic bodies. 

- Preprocessor generates finite element mass, damping and stiffness matrices 
for each link with user-selectable end boundary conditions. 

- Linearized models can be loaded in the control analysis software packages 
MATLAB and MATRIXx. 

- Nonlinear TREETOPS simulation can be run with the MATRIXx/System-Build 
nonlinear simulator. This allows to easily design and simulate control laws 
with the TREETOPS-generated dynamic models. 

• Simple analytical models have also been derived to understand the basic 
characteristics of the system to control: linear and nonlinear models for a 
1-DOF, and 2-DOF planar slender elastic arms with a rigid payload and with 
nonlinear or linear geared actuators. 
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Control of Elastic Arms: Dynamic Modelling (cont'd) 

• Equations of motion for 2-DOF elastic arm numerically assembled by TREETOPS: 


M* (x r ) M re (x r ) 

t 


X 

+ 

Dit 2 2n 
2 n2 Dee 


X 

M re (x r ) M ee 


X'e 



X e _ 


2 ;2 2 n 



2 a2 Kee 


X 




t 



where X r and X e are respectively the joint angles and the generalized elastic coordinates 


• Equations of motion are linearized around a given arm configuration. A 
state-space model is derived with the two control actuators as inputs. The model 
outputs are the joint angles, motor rates and linearized tip displacements (dx,dy). 

• Characteristic System frequencies: JL= free joints FF = joint locked. 


1 System Frequencies (Hz) 

| for No Payload Configuration 

Mode 

««> 

= 0° | 

0 r = 

= 00° 

No. 

J L 

FF ! 

JL 

FF 

i ! 

0.29 

5.12 

0.36 

5.00 

2 i 

1.50 

6.70 

0.94 

6.54 

3 i 

7.53 

18.3 1 

7.27 

18.2 

4 

14.5 

25.3 

14.3 

25.1 

5 

1 27.1 

40.9 

26.6 

40.9 

6 1 

38.7 

63.2 

38.6 

63.1 j 


Control of Elastic Arms: Colocated PD Control 


• Closed-loop system block diagram: 



• PD controller with joint position and motor velocity feedback: 


T s = - [kp s (e s -0s) + k Rs e s ] L 2 s (s) 

T e = - ^ kp e ( 0 e - 0 e ) + k Re 0 e J L 2 e (s) 

where L,2 S andL2 e are two second-order lag filters: 


L2( s ) = - 


S + 2^ z o) 7 s + a>; 


S + 2C “pS + o>; 
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Control of Elastic Arms: Colocated PD Control (cont d) 


• Example of gain-stabilization of the 4th vibration mode (85 Hz) with PD 
controller implemented at 200 Hz. Second-order lag filter provides 
high-frequency roll-off in compensator: 


ODen-looD shoulder transfer function G (s) K (s 


ShouW* Broken-Loop Trent* Ftnctiofl 


Ho Sfiapnq niter 
m Sh*>ra Filter 


Mo SKaong Filter 
With Shaoeng Fitter 


Frequmc* (Lag hi) 








Control of Elastic Arms: End-point Controller 



• End-point controller is designed for configurations with the elbow angle nearly 
equal to 90 degrees: 

- Tip sensor Xt channel is fed back to elbow actuator. 

- Tip sensor Yt channel is fed back to shoulder actuator. 

• For each channel, the tip controller consists of a second-order lead compensator 
with motor rate feedback: 

Ti= ' [kpi (7^xlb) (Zi ' z i )+kRi ^ ] L2i<s) 

with (a « b & c} andlvjj is a second-order lag filter. 
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Control of Elastic Arms: PD Control vs End-point Control 


• Arm is commanded to move along a straight line in the y-direction: 

- A fifth-order spline command profile is used for the tip position command 

- For the independent joint controller, equivalent joint command profiles are 
computed using inverse kinematics (assuming arm is rigid). 

• Arm configuration for reference slew maneuver: 
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Experimental Ti me Responses for Slew Maneuver 


Cartesian End Point Responses 


Desired 
Tip Cntri 
Jnt Cntri 


X (m) 


Tip Sensor Responses 


Control Torques 




— i — ■ — ■ — i — i — i i i — i — ■ — 
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Tip 

Cntri 

V 

.... 

Jnt 
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4 6 8 

Time (sec) 
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Control of Elastic Arms: Disturbance Response to Tip Forces 

• Experimental set-up: 



The arm is under closed-loop control in a given configuration 
(joint or tip control). 

A constant force is applied at the tip using a force gage. 

After steady-state has occurred, tip force is removed. 
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Control of Elastic Arms: Disturbance Response toTip Forces (cont’d) 



• Effective cartesian stiffness with tip position control is one order of 
magnitude larger than with joint feedback. 

• With joint control, tip disturbance forces excite fundamental 
low-frequency and the lightly-damped elastic mode of the arm (0.5 Hz 
frequency). With tip controller, transient response is well damped. 
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Conclusions 


• With additional sensing capability, simple and robust control laws can be 
used for active damping of space robots: 

- wrist-mounted force/torques sensors can be used to damp out large elastic 
payload vibration modes with a simple impedance control law. 

sensors which directly sense the wrist motion can be used to damp out link 
elastic modes for RMS-class arms. 

output torque sensors can also be used to damp out gearmotor elastic 
modes. 


• Experimental testbeds have been designed to validate modelling 
techniques and to demonstrate in 2-D the feasibility of new 
control/sensing implementation for FTS/SPDM-class and RMS-class 
manipulators. These testbeds are useful as a complement to 3-D 
simulation studies. 


Space-based experiments should be planned to demonstrate 
CSI-technology for FTS/SPDM-class and RMS-class manipulators. 




